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Hybrid Attitude Observer on SO(3) with Global Asymptotic Stability 

Tse-Huai Wu, Evan Kaufman and Taeyoung Lee* 


Abstract —This paper presents a deterministic hybrid ob¬ 
server for the attitude dynamics of a rigid body that guarantees 
global asymptotical stability. Any smooth attitude observer 
suffers from the inherent topological restriction that it is 
impossible to achieve global attractlvity, and as such, attitude 
observers have been developed with almost global asymptotic 
stability. We demonstrate that such attitude observer may 
yields very slow initial convergence rates, and motivated by 
this, we propose a hybrid attitude observer that guarantees 
global asymptotic stability on the special orthogonal group. 
We Illustrate that the proposed observer exhibits substantially 
improved convergence rate uniformly via numerical examples 
and experiments. 

1. Introduction 

Attitude estimation has been intensively studied with var¬ 
ious filtering approaches and assumptions [1]. They can be 
categorized with the choice of attitude representations. It is 
well known that minimal, three-parameter attitude represen¬ 
tations, such as Euler-angles or modified Rodriguez parame¬ 
ters, suffer from singularities. They are not suitable for large 
angle rotational maneuvers, as the type of parameters should 
be switched persistently in the vicinity of singularities. 

Quaternions are another popular choice in attitude esti¬ 
mation [2], [3], [4]. They do not have singularities, but as 
the configuration space of quaternions, namely the three- 
sphere double covers the special orthogonal group of the 
attitude configuration space, there exists ambiguity. This 
implies that a single attitude may be represented by two 
antipodal points on the three-sphere. The ambiguity should 
be carefully resolved in any quaternion-based attitude ob¬ 
server and controller, otherwise they may exhibit unwinding, 
where an initial attitude estimate goes through unnecessarily 
large rotations even if the initial estimate error is small, or it 
becomes sensitive to noise [5]. To resolve this consistently, 
an additional mechanism to lift the measurement of attitudes 
into the three-sphere has been introduced [6]. 

Instead, attitude observers have been designed directly on 
the special orthogonal group to avoid both singularities of 
local coordinates and the ambiguity of quaternions. These 
include, for example, complementary filters [7], [8], an 
observer in the presence of angular measurement noise [9], 
and attitude estimation with single vector measurements [10], 
[11]. However, these results are commonly restricted by 
the topological restriction of the special orthogonal group, 
prohibiting global attractivity for smooth attitude flows [5]. 
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As such, they guarantee almost global asymptotic stability 
instead, where the region of attraction excludes a certain set 
of zero measure, which corresponds to the stable manifold 
to undesired equilibria. This is considered as the strongest 
stability property that can be achieved by smooth attitude 
estimators. 

The fact that the region of attraction does not cover the 
entire configuration manifold does not seem to be a major 
issue in practice, as the probability that an initial condition 
exactly lies in such undesired set is zero, provided that the 
initial condition is chosen randomly. But, the existence of 
those undesired equilibria may have nontrivial effects on the 
attitude dynamics [12]. In particular, attitude estimators may 
yield significantly poor convergence rates, especially with 
large initial attitude estimator errors. As a result, an initial 
attitude estimate that is close to the exact opposite of the true 
attitude may not be corrected for a while, thereby causing 
significant performance degradations. 

Recently, in attitude control systems, the topological re¬ 
striction of the special orthogonal group has been addressed 
via hybrid control system approaches [6], [13], where a 
hysteresis-based switching algorithm is introduced to achieve 
global asymptotic stability. A new set of attitude error 
functions is introduced in [14], [15] to guarantee stronger 
global exponential stability with an explicit and compact 
form of stability criteria. 

The main objective of this paper is to achieve global 
asymptotic stability in attitude estimation, while addressing 
the ambiguity of quaternions and the topological obstruction 
of the special orthogonal group concurrently. The synergistic 
attitude error functions introduced in [14], [15] are based on 
two preselected reference directions that should be orthog¬ 
onal with each other, and they are not suitable for attitude 
estimation that are based on attitude measurements or line- 
of-sight measurements toward, possibly many, arbitrary ref¬ 
erence objects. We first introduce revised synergistic attitude 
error functions without such restrictions of [14], [15], and 
apply them to attitude estimation while compensating the 
effects of a fixed bias in angular velocity measurements. The 
key idea is designing a set of attitude error functions such 
that attitude estimates are expelled from undesired equilibria 
to achieve global asymptotic stability. 

Perhaps, the only other attitude observers that guarantee 
global attractivity corresponds to the work in [16], [17]. 
However, it is considered that the special orthogonal group 
is embedded in a linear space, and an observer is designed 
on the linear space to overcome the topological restriction. 
Therefore, the estimated attitude does not necessarily evolve 
on the special orthogonal group. In short, attitude observers 



constructed on the special orthogonal group that guarantee 
global asymptotic stability have been unprecedented, and it is 
the unique contribution of this paper. The desirable properties 
of the proposed approach are illustrated by both numerical 
examples and experimental results. 

Another contribution of this paper is developing a numer¬ 
ical algorithm to implement the proposed attitude observer 
while preserving the structures of the special orthogonal 
group. It is well known that conventional numerical inte¬ 
grators, such as the Runge-Kutta method and its variations, 
do not conserve the orthogonality of rotation matrices, 
thereby yielding attitude estimates that are incorrect geo¬ 
metrically [18]. This paper construct a numerical algorithm 
based on the Lie group method [19], to guarantee that 
the estimated attitudes evolve on the special orthogonal 
group. The desirable properties of the proposed approach 
are illustrated by both numerical examples and experimental 
results. 

The preliminary results of this paper have been presented 
in [20]. This paper include experimental verification, ge¬ 
ometric numerical algorithm, and stability proof that have 
not discussed in [20]. The paper is organized as follows: an 
attitude estimation problem is formulated, and prior results 
are summarized at Sections II, and III respectively. A hybrid 
attitude observer guaranteeing global asymptotic stability is 
proposed at Section IV, followed by numerical examples with 
geometric numerical integration techniques and experimental 
verification. 

II. Problem Formulation 

Consider the attitude dynamics of a rigid body. Two 
coordinate frames are defined: an inertial reference frame 
and a body-fixed frame. The attitude of the rigid body is 
described by a rotation matrix R G SO(3) that represents the 
transformation of a representation of a vector from the body- 
fixed frame to the inertial reference frame. The configuration 
manifold of attitude is the special orthogonal group: 

SO(3) = {R& I R^R = /, det[i?] = 1}. 

Let w G and O G denote the angular velocities of the 
rigid body, represented with respect to the inertial reference 
frame, and the body-fixed frame, respectively. The attitude 
kinematics equations are given by 

R = loR = rCi, (1) 

where the hat map A : —)• so(3) transforms a vector in 

to a 3x3 skew-symmetric matrix such that xy = x'^y = xxy 
for any x, y G And the inverse of hat map is denoted 
by the vee map V : so(3) —> Several properties of hat 


map are listed as follows: 

X X y = xy — yx = yx^ — xy^, ( 2 ) 

tr[Aa;] = tr[a;A] = —x^ {A — A"'"), (3) 

RxR^ = {Rx)^, ( 4 ) 

xA -I-= ({tr[A]/3x3 - A}x)^, (5) 


for any x G A G R G S0(3). The standard inner 

product of two vectors is denoted hy x-y = x^y. Throughout 
this paper, / 3 X 3 denotes the 3x3 identity matrix and the 2 - 
norm of matrix A is denoted by ||A||. 

The measurement model is as follows. Let uf G = {u G 
I II u II = 1} be the unit-vector from the origin of the body- 
fixed frame along the z-th reference direction represented 
with respect to the inertial frame. They may be the direction 
of the gravity, the direction of the magnetic field, or the line- 
of-sight toward a distinctive point. It is assumed that there 
are n > 2 distinct, known reference directions. Also, they are 
normalized such that ||u/|| = 1. The rigid body is equipped 
with sensors to measure such reference directions, such as 
an accelerometer or a magnetometer, and the corresponding 
z-th measurement, namely vf G is obtained with respect 
to the body-fixed frame as 

vf = R^vl. ( 6 ) 

Also, it is assumed that the angular velocity is measured 
with a gyro with a unknown but fixed bias, such that the 
measured angular velocity G is written as 

^y = n + -i, (7) 

where 7 G denotes the constant gyro bias. In short, the 
measurements correspond to {uf,.. .u®} with zz > 2 , and 
Vly. We wish to design an observer to estimate the attitude 
of the rigid body R, and the gyro bias 7 , based on these 
measurements. 

III. Almost Global Attitude Observer on S0(3) 

In this section, we first review the the passive complemen¬ 
tary filter with bias correction presented in [ 8 ]. This attitude 
estimator is shown to guarantee almost global asymptotic sta¬ 
bility, where there exist three additional undesired equilibria 
along the flows of the filter. 

A. Estimate Frame and Error Variables 

Define an orthonormal frame estimated by the observer. 
The orientation and angular velocity of the estimate frame 
with respect to the inertial reference frame are denoted by 
R G SO(3) and w G respectively. More explicitly, R 
denotes the linear transformation from the inertial reference 
frame to the estimated frame. 

The discrepancy between the true attitude R and the 
estimated attitude R is denoted by a rotation matrix R G 
SO(3) defined as 

R = R^R, (8) 

which corresponds to the linear transformation from the 
body-fixed frame to the estimated frame, and R = 13 x 3 
when R = R. 

The vector v( representing the known, reference direction 
can be expressed with respect to the estimated frame to 
obtain. 


vf = R^vf. 


(9) 



Note that vf = vf when there is no estimation error, 
i.e., R = Isxs- Define an error function representing the 
discrepancy between vf and vf as 

= 1 - vf^vf, ( 10 ) 

which can be rewritten from ( 6 ) and (9) as 

'I'j = 1 — vf~'^vf = 1 — tT[vfvf^\ = 1 — vlvl^ R\. 

For distinct positive constants ki,...,kn, the overall con¬ 
figuration error function 'h e IR is defined as the weighted 
sum, 

n n 

= '^k^'S^ = '^ki-ti\R^KR], (11) 

where the symmetric matrix K is given by 

n 

K = '^kivivG = (12) 

As it is symmetric, it can be decomposed into 

K = UGU~^, (13) 

where the orthogonal matrix U G are composed of 

the normalized eigenvectors of K, and the diagonal matrix 
G = diag(Ai, A 2 , A 3 ) is defined by the real non-negative 
eigenvalues Ai,A 2 ,A 3 € M of K. When n > 3, the matrix 
K is positive-definite, and all of the eigenvalues are strictly 
positive. When n — 2, there is a single zero eigenvalue. 
Without loss of generality, we can assume U G SO(3) by 
reordering. For example, if det(C/) = —1, the first two 
diagonal elements of G, and the first two columns of U can 
be swapped such that det(C/) = -fl. 

In addition, let the estimated gyro bias 7 € and the 
bias estimation error be defined as 

7 = 7 - 7 - (14) 

B. Complementary Filter 

The complementary filter [ 8 ] is defined as 

R = R[{ny-y) + kReR]^, (15) 

7 = -kiCR, (16) 

n 

eR = '^hvfxvf, (17) 

i=l 

where kR,ki G^ are positive constants and br G is the 
innovation term. 

Proposition 1: [ 8 ] Consider the attitude kinematics (1) 
with the measurements ( 6 ) and (7). The attitude observer 
given by (15), (16) and (17) satisfies the following properties. 

• There are four equilibria, given by 

(77, 7) G {{R, 7), {UD.U^R, 7 )}. (18) 

for £>1 = diag[l, — 1 , — 1 ], D 2 = diag[— 1 , 1 , — 1 ] and 
£>3 = diag[-l,-l,l]. 

• The desired equilibrium {R, 7 ) = (i?, 7 ) is almost 
globally asymptotically stable. 


In summary, this observer guarantees that the estimated 
attitude asymptotically converge to the true attitude for 
almost all cases, excluding the estimated attitudes starting 
from a set of zero measure that corresponds to the union of 
the stable manifolds to the above three undesired equilibria. 
While there is no chance in practice that the observer is 
initialized by such a thin set which does not yield asymptotic 
convergence, the existence of such stable manifold to the 
undesired equilibria may have strong effects on the estimator 
dynamics [12]. More explicitly, the convergence rate may 
become very slow near the undesired equilibria, and it is par¬ 
ticularly undesirable as undesired equilibria represent large 
estimation errors, i.e., the estimated attitude is opposite to the 
true attitude. This motivates the subsequent development for 
a hybrid attitude estimator with global asymptotic stability. 

IV. Global Attitude Observer on S0(3) 

Hysteresis-based switching algorithms have been intro¬ 
duced to achieve global asymptotic stability [ 6 ], [13], and 
global exponential stability [14], [15] in attitude controls. 
In particular, the set of attitude error functions formulated 
in [14], [15] has desirable properties that guarantee stronger 
global exponential stability with an explicit and compact 
form of stability criteria. But, it is constructed with two 
pre-defined reference directions that are assumed to be 
orthogonal with each other, and therefore, it is not suitable 
for the presented attitude estimation problem that is based 
on an arbitrary number of unit-vector measurements. 

In this section, we present a new set of synergistic attitude 
error functions, and utilize it for the attitude estimation 
problem with a gyro-bias correction. The key idea is that the 
error functions are designed such that the attitude estimate 
is expelled from the vicinity of the undesired equilibria. 

A. Estimate Frame and Error Variables 

We first derive additional properties of the attitude error 
function and error variables defined at the previous section. 
Let Ui G be the £th column of the matrix U, i.e., U = 
[ 111 ,^ 2 , M 3 ] G SO(3), and therefore, U 3 = ui x U 2 - Also, let 
bi,bi G be the representations of Ui with respect to the 
body-fixed frame, and the estimated frame, respectively, i.e., 

bi = R^Ui and bi = R^m. (19) 

Note that 63 = x & 2 , and b^ =bi x &2 as well. 

The unit-vectors bi can be obtained directly from the 
measurements vf as follows. Define a symmetric matrix 
Kb G as 

n 

Kb = Y^ kivfvf^ = R^KR, (20) 

where ( 6 ) and (12) are used for the second equality. Substi¬ 
tuting (13), (19), this can be written as 

Kb = R^UGU'^R = BGB'^, (21) 

where the matrix B = R^U is composed of bi from 
(19), i.e., B = [ 6 i, 62 ,& 3 ] G S0(3). In short, for a given 
set of measurements, vf, defining the matrix Kb ( 20 ), 



and decomposing it as ( 21 ) yields the orthonormal unit- 
vectors 6 i, 62 ,& 3 - Their estimates are obtained by 

the second equation of (19). 

From (12), we have tr[K] = = 

'^he other hand, from (13), tr[iT] = tr[G] = 
X]i=i Also, (13) is rewritten into K — Y^^=i ^i^iuj . 
Using these, the attitude error function T* defined at (11) 
can be rearranged as 

3 3 

'^> = Y,X^-tr[R^X^s,sJR]=Y,^^i^-bJb^). ( 22 ) 

i=l i=l 

Therefore, the attitude error function is obtained by compar¬ 
ing bi with bi. 

Next, we show that the undesired equilibria defined at (18) 
can be expressed in terms of bi. Since Si are column vectors 
of U, it can be shown that UDiU^ = exp( 7 r'Ui). Therefore, 
the undesired equilibria can be written as 

UDiU^ R = exp(7rui)i? = i?exp(7r6i), 

where we have used the fact that exp(i?a;) = i?exp(a;)i?, 
for any rotation matrix R G SO(3) and any vector x G M. 
This shows that the z-th undesired equilibrium is obtained 
by rotating the true attitude about bi by 180°. The values of 
bi at undesired equilibria are summarized later at Table I. 

B. Expelling Attitude Error Functions 

Next, we design a hybrid attitude observer to avoid the 
undesired equilibria to achieve global attractivity. We first 
introduce a mathematical formulation of hybrid systems as 
follows [21]. Let A4 be the set of discrete modes, and let Q 
be the domain of continuous states. Given a state (m, ■J) € 
M X Q, a hybrid system is defined by 

C = (23) 

m+=(;(m,^), (24) 

where the flow map F ■. Q describes the evolution 

of the continuous state the flow set C C Af x Q defines 
where the continuous state evolves; the jump map Q : A4 x 
Q —> A1 governs the discrete dynamics; the jump set V C 
M X Q defines where discrete jumps are permitted. 

The proposed hybrid attitude observer is composed of 
one nominal mode and two distinct modes. Define the z-th 
nominal error function as 

A!N^=l-bJb,, (25) 

for z = {1,2,3}, where its definition is motivated by (22). In 
the vicinity of the undesired equilibrium where bi = —bi, 
the error function is switched into the following expelling 
error function, 

'i>Ei = 0! +^bJibi X b 2 ) = a +Pbjbs, (26) 

for constants a, (3 satisfying 1 < a < 2 and ||/3|| < a — 1 . 
The attitude observer designed with the above expelling error 
function steers the estimated direction bi toward a direction 
normal to —bi, namely x ^ 2 , such that the estimated 

attitude is rotated away from the undesired equilibrium. 


Similarly, the following expelling error function is engaged 
near the undesired equilibria where 62 = — & 2 , 

= a-I-/SbJ (61 X 62 ) = a +/3&J&3. (27) 

More explicitly, there are three modes A4 = {I, II, II} in 
the proposed hybrid attitude observer, and the attitude error 
function for each mode is given by 

(28) 

^ii(^) = AiT'atj-I-A 2 T '£;2 + Aa'I'jVa, (29) 

'Fiii(.R) = AiT'b^-I-A 2'I'7V2 + AaT'Afj. (30) 

Next, to formulate the switching logic of the proposed 
hybrid system, a variable p is defined as the minimum 
attitude error among three modes, 

p(i?) = min {4-^(7?)}, (31) 

meAt 

for A1 G {I, II, III}. The jump map is chosen such that the 
discrete mode is switched into the new mode that yields the 
above minimum error, i.e., 

Q{R) = arg min'Flu(.R) = {m G M : T'm = p}- (32) 

meAt 

It is possible to switch whenever 'Fm > p. However, it may 
cause chattering due to measurement noise. Instead, we intro¬ 
duce a positive hysteresis gap G M for improved robustness, 
and the switching is triggered if the difference between the 
current configuration error and the minimum value is greater 
than 6 . This leads to the following formulation of the jump 


set and the flow set: 

V = {{R,ni):^^-p>d}, (33) 

C = {(i?,m) :T-^-p<,5}. (34) 

C. Elybrid Attitude Observer 

For positive constants kj, the proposed hybrid attitude 
observer is defined as 

R = Rmy-y) + kReHr, (35) 

7 = -kiCH, (36) 

3 

ezz = ^Ajerz,, (37) 

i=l 


where the z-th hybrid innovation terms eui are given by 



\bi X bi 


if 

m = 

A, II, 

(38) 

e/Zi - ( 

[-/ 3(&3 X 

bi) 

if 

m = 

in. 

I 

f 62 X 62 


if 

m = 

I, in. 

(39) 

6^2 - } 

[-Pibs X 

(>2) 

if 

m = 

n, 

e/Zg = b 

3 X &3 


for 

m 

= i,n,ni, 

(40) 


which are obtained by taking the derivatives of the attitude 
error functions defined at (28)-(30). Note that the observer 
in the nominal mode m = I is the same as (15)-(17). 

Proposition 2: Consider the attitude kinematics (1) with 
the measurements (6) and (7). The hybrid attitude observer 



is defined by (31)-(40), where 1 < a < 2 and |/3| < a — 1. 
Choose the hysteresis gap <5 such that 

0 < (5 < min{Ai, A 2 }niin{2 — a, a — \j3\ — 1}, (41) 

where Ai is defined at (13). Then, the desired equilibrium 
{R, 7) = {R, 7) is globally asymptotically stable, and the 
number of discrete jumps is finite. 

Proof: See Appendix A. ■ 

The proposed hybrid attitude observer guarantees that the 
estimated attitude and the estimated gyro bias asymptotically 
converge to their true values globally. Compared with [16], 
[17], these are constructed directly on S0(3) such that the 
estimated attitude R lies in SO(3) always. Furthermore, the 
proposed hybrid attitude observer exhibits substantially better 
convergence rate than other attitude observers guaranteeing 
almost global asymptotic stability, such as [ 8 ], at certain 
cases as illustrated below. 

V. Numerical Analysis 

General purpose numerical integration techniques, such 
as the Runge-Kutta method, are commonly applied to im¬ 
plement any estimation algorithm numerically. However, 
conventional numerical integrators are not suitable for the 
proposed attitude observer, as the attitude estimate computed 
such numerical integrators are not orthogonal in general [18], 
thereby yielding geometrically incorrect attitude estimates. 
Here, we present a numerical algorithm for the proposed 
attitude observer, to ensure that the corresponding attitude 
estimates evolve on the special orthogonal group numerically. 

A. Geometric Numerical Integration 

The proposed algorithm is based on the Lie group [19], 
where the attitude estimates are updated by the group oper¬ 
ation of SO(3), namely the matrix multiplication to ensure 
that they evolve on SO(3) numerically. 

First, define the estimate angular velocity ft = illy — f + 
kRCH € Let Rn and ftn denote the estimate attitude 
and angular velocity at the n-th time step, respectively. The 
intermediate updates are given by 

K+i = Rn, f'n+i = 7„ + hKi_^, 

where G M is the step size, and the intermediate increments 
g and g are defined as 

Ri — ) -^71 — kjC-R[^{^Ryi,Rri), 

In contrast to the conventional Runge-Kutta method, that 
would yield R'^+i = Rn + here R'^+i is constructed 

by the product of two rotation matrices to ensure Rn_^.l is 
orthogonal numerically. 

Next, the second stage increments are evaluated by 

^R2 ~ ^72 = ~kieHn+i{Rn+l, Rn+l)j 

where fl'n+i = — 7 ^+i + kReH„+i G Combining 

the increments from both of the stages, we can obtain R and 
7 for the (n -f l)-th step; 


Tn+l 7 n -^72)’ 

These correspond to the second-order Crouch-Crossman 
method [18]. 

B. Numerical Examples 

We select three linearly independent vectors in the inertial 
frame, v( = Ui'^/||u'^||, for f = 1, 2, 3, where v'/ = [—2 5 2]^ 
V 2 = [10 — 1 0]^ and = [01— 2]^. The true attitude 
trajectory is selected in terms of 3-2-1 Euler angles as 

R{a{t), b{t), c(f)) = exp(ae 3 ) exp(be 2 ) exp(cei), 

where o = sin(0.5f), b = 2sin(f), c = cos(2f) — 3. These 
represent a non-trivial complex rotational maneuver. The 
initial value of estimate attitude and estimate bias are given 
by 

0.2527 -0.8907 -0.3779 

R{0) = 0.6381 0.4470 -0.6270 , 

0.7273 -0.0827 -0.6813 

and 7 = [0.0997 - 0.1042 0.2027]"r, respectively. The 
controller parameters are chosen as ki = 1.211, ^2 = 1.21, 
ks = 1.209, kR = l,ki = 0.25, a = 1.9 and /? = 0.899. 

The simulation results for the smooth complementary 
attitude filter [8], and the proposed hybrid attitude observer 
are illustrated at Figure 1 for the first case when there is no 
gyro bias, i.e., 7 = 0 , and at Figure 2 for the second case 
with a non-zero gyro bias, 7 = [0.1 —0.1 0.2]^, respectively. 
They are computed via the proposed numerical integration 
algorithm with the time step h = 0.05 sec. For both cases, 
the attitude estimation error of the complementary filter does 
not change for the first few seconds even though the estimate 
error is very large, but the proposed hybrid attitude observer 
exhibits a substantially faster convergence rate by engaging 
the third, switching mode initially and switching back to the 
normal mode later at f = 1.40 seconds and t = 1.15 seconds, 
respectively. 

We further compare the proposed geometric numerical 
integration algorithm to a conventional 4/5th Runge-Kutta 
method for the second case. Simulation results at Figure 3 
show that two methods perform well over the first 20 
seconds. However, the attitude estimation error of the Runge- 
Kutta method increases noticeably later. This is caused by 
the fact that the computed R deviates from SO(3), and such 
error may accumulate as illustrated in Figure 3(b). 

VI. Experimental Verification 

We also demonstrate the desirable properties of the pro¬ 
posed hybrid attitude observer via a fully-actuated UAV 
platform described in [22], which is attached to a spher¬ 
ical joint such that three attitude degrees of freedom are 
controlled. The control system serves to stabilize the UAV 
such that the mass center of the UAV is directly above the 
spherical joint for a fixed desired attitude Rd = G 

SO(3), which is in fact unstable without a controller (see 




(a) Attitude estimation error ||_R — _R|| (b) Mode change 
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Fig. 1. Attitude estimation without gyro bias (blue: hybrid observer, red: 
smooth complementary observer). 


Fig. 3. Attitude estimation error ||H — R|| (blue: MATLAB ode45, red: 
geometric Runge-Kutta method). 



(a) Initial attitude (b) Stabilized attitude 

Fig. 4. The observer must provide accurate attitude estimates to a control 
system designed to stabilize the UAV above a spherical joint. 
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Fig. 2. Attitude estimation with gyro bias (blue: hybrid observer, red: 
smooth complementary observer). 


Figure 4). Therefore, accurate attitude estimation is crucial 
to stabilizing the controlled system at this equilibrium. 

We apply both the smooth complementary attitude ob¬ 
server [ 8 ] and the proposed hybrid attitude observer to 
control the attitude, where the estimated attitude and the 
angular velocity measured by an IMU are used to compute 
the control input. 

The experimental results are illustrated at Figure 5, which 
show several important aspects of applying the observers 
to realistic scenarios. It is illustrated that the proposed 
hybrid attitude observer exhibits considerably faster initial 


convergence rate for the attitude estimation error. Initially, 
the hybrid observer is at the mode III, causing a steeper 
decrease in attitude error than the complementary observer, 
which is confined to the mode I at Figure 5(a). 

The experimental results also demonstrate how the perfor¬ 
mance of the control system depends heavily on the estimate 
provided by the observer at Figure 5(d). Indeed, when 
the UAV depends on the smooth complementary observer, 
the controlled system requires roughly 50% more time to 
stabilize than when the hybrid observer is used because the 
smooth complementary observer provides a more inaccurate 
attitude estimate for a longer time period. 

VII. Conclusions 

It is well known that attitude estimators suffer from the 
topological restriction inherent to the special orthogonal 
group that prohibits any smooth estimator to achieve global 
attractivity. We demonstrate that this may cause significant 
performance degradation at certain cases, and motivated by 
this, we propose a hybrid attitude observer that guarantees 
global asymptotic stability. This exhibits desirable properties 
that the convergence rate is substantially faster, and the 
estimated attitudes evolve on the special orthogonal group. 
These are illustrated by numerical examples and an experi¬ 
ment. 


Appendix 

A. Proof for Proposition 2 

a) Equilibrium Configuration: For each configuration 
error function T'm, there are four equilibrium configurations 
that corresponds to the critical points of T'jn- Hence, there 
are twelve critical points, including the single desired equi¬ 
librium and eleven undesired critical points. The values of 
( 61 , 62 , ^ 3 ) for each critical point are summarized at Table I. 
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b) Time-derivative of Next, we derive the time- 
derivative of for each mode in the flow set. From (19), 



(a) Attitude estimation error \\R — i?|| 
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(c) Hybrid innovation term ejj (d) Attitude control error ||i? — R^W 


Fig. 5. Experimental results (blue: hybrid observer, red: smooth comple¬ 
mentary observer) show that the hybrid observer converges faster than the 
complementary observer. 


hi = Si = —ClR^ Si = —Clbi, 

bi = R^Si = - 7) + kReH,Vbi, 

From (25)-(27), the time-derivative of is 

'^Ni = -{kVh - bjbi 

= —bj (fi -f 7 -f kReHi)^bi -f bJClbi 

= -bJClb, - bj^b^ - kf/bJicHM) + hJClbi 

= ^'^{bi X b,) + kaeR.ibi x bi), 

and the time-derivatives of ^6 given by 

i>E^=P[{h)'^b^ + b~lb^] 

= P[bj (F! + 7 + knenj^bs - bJClbs] 

= PibJClbs + bj% + kubJicHM) - bJClba] 
= X bi) + kiie\.l3{b^ x h), 

for i = 1, 2. Therefore, combining these. 


TABLE I 

CONHOURATIONS OF CRITICAL POINTS 



Critical Point 

(5i, 62 , 63 ) 

p 

'Ll 

Desired 

Undesired 1 

Undesired 2 

Undesired 3 

(fei, 62 , 63 ) 
(-fei, b2, -bi) 
(bi, -b2, -bi) 
(-bi, -b2, bi) 

0 

Ai(2-a) 

A 2 ( 2 -a) 

Ai(2-a) 

I'll 

Undesired 1 

Undesired 2 

Undesired 3 

Undesired 4 

{bi, —bi, 62 ) 
{—bi, —bi, —bi) 
(bi, bi, —bi) 
(—bi, bi, bi) 

Mp 

Ai(2 — a) + ^2P 
A 2 A‘ 

Ai(2 — a) + XiU 

I'm 

Undesired 1 

Undesired 2 

Undesired 3 

Undesired 4 

{—bi, bi, bi) 
{-bi, —bi, —bi) 
{bi, bi, —bi) 

{bi, —bi, bi) 

Ai(a-/3-l) 
Airt + A 2(2 - a) 
Xip 

Xii/ + ki{2 — a) 


= (7 + kneH)'^ I ^ Kbi x j 

Z = 1 \i=l / 

= -(7 -f kReH)^eH = -l^en - kRWenW^, (42) 
for m = I. Also, for m = II, we can show that 

'i'll = -f X 2 "^e 2 + Xs'iN 3 

= (7 -f kReH)'^[bi xbi+ f 3 {b 3 x 62) + ^3 x 63] 

= -l^en - fcitller/f, 

which can be repeated for Tim to conclude that 

= —7^eir — A:ij||err|p, (43) 

for any m = {I, II,III}. 

c) Stability Proof: Define a Lyapunov function as 


We hrst show that those undesired critical points cannot 
become an equilibrium of the proposed hybrid attitude ob¬ 
server, as they belong to the jump set. For example, at the 
third undesired critical point of the nominal mode m = I, 
when (bi,b 2 ,bfj = {-bi,-b 2 ,bfj, we have 

'hi = 2 (Ai -f A2), 'hii = 2 Ai -f A2a, 'I'ni = Aict -I- 2A2, 

where ihi > 'hn > 'Flu as a < 2 and Ai > A 2 > A 3 . 
Therefore, p — 'Flu and 'Fj — p = Ai(2 — a) > 5 from (41). 
Hence, the corresponding undesired critical point belongs to 
the jump set V defined at (33), and it cannot become an 
equilibrium. This can be repeated to show that all of the 
eleven undesired equilibria belong to the jump set as well, 
and the only equilibrium of the proposed hybrid attitude 
observer is the desired equilibrium. 


V„. = 'F,„+^||7f, 

which is positive-definite about the desired equilibrium R = 
R with 7 = 0 at the mode m = I. 

We first analyze the change of the Lyapunov function 
when restricted to the flow set as follows. From (36) and 
(43), the time-derivative of V is given by 

V = ^ + ■^7'''7 = eu - fcfl||e_fr||^ -I- eR 

ki 

= -kR\\eH\\\ (44) 

which implies that the Lyapunov function is non-increasing, 
limt_,,oo 11 err 11 = 0^ |j 7 |j is uniformly bounded. Further, 

with the assumption that ||H|| and ||H|| are bounded, one can 
show that 11 err 11 is uniformly bounded as well, which follows 
limt_>oo err = 0, from Barbalat’s Lemma [23, Lemma 8.2]. 






























For m = I, these can be used to shown the convergence 
of the gyro bias error as follows. From (2) and (17), the 
innovation term ch can be written as 

n n 

eH h{vf X vf)'^ = ^ hvfvf^ - vfvf^ 

= hvlvf^ R- kivlvf^ R 

= R^KR - R^KR. 

From (1), (35), the time-derivative of en is 

hn = + ^ + kReuTR^KR + R^ KR(1 + Cir'^KR 

- R'^KR{il + j + kReH)'". 

Using (5), it is rewritten as 

ch = —{tT[R^KR]l3x3 — R^KR){^ + kRen) + e/rU. 
Since limj^oo W^hW = linit^oo W^hW = 0, 

lim II(tr[i?Tifi?]/ 3^3 _ R^KR)^\\ = 0. (45) 

t—¥OC> 

From (12), the matrix in the above equation is written as 

tr[i?'rit:i?]/3x3 - R^KR 

= i?'^C/(tr[G(7]/3x3 - Gi})U^R, 

where tj = U^RR^U € SO(3). One can show 
rank(tr[G17]/3x3 — GU) = 3 when JJ = I, such that 
tr[/j^iFi?] 73 x 3 — R^KR also has the full rank in the limit 
as f —> oo. Then, (45) implies limi_>oo HtH = 0. In short, the 
Lyapunov function asymptotically converges to zero for m = 
1. Together with (44), these can be repeated on other two 
modes, to show that the Lyapunov function asymptotically 
converges at any mode of the flow set. 

Next, the change of the Lyapunov function over the jump 
from a mode m to a new mode (I(m) given at (32) is 

Vp 'Vm — P 4/m ^ 

where the last inequality is from the definition of the jump set 
(33). In other words, the Lyapunov function strictly decreases 
over any jump. 

From these, it follows that the desired equilibrium 
{R, 7 ) = (i?, 0) is globally asymptotically stable, and the 
number of jumps is finite. 
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